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(54) CONTROLLER FOR LEG-TYPE MOBILE ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To easily and properly control an 
actual reactive force applied on a robot without any 
interference by providing a leg part rotational amount 
deciding means or the like. 

SOLUTION: The coordinate of a first target sole floor 
reactive force center point and the coordinate of a second 
target sole floor reactive force center point are rotated and 
moved around a normal vector by amounts equal to a 
rotational angle 0 (both-leg compensating angle) with 
respective target full- floor reactive force center points set 
as rotational centers. In this case, by simultaneously 
operating both-leg compensating angle, each sole X 
compensating angle and each sole Y compensating angle, the 
changing amount of each actual sole floor reactive force is a 
sum of a changing amount when each is singly operated. 
Accordingly, these operations have linear characteristics. 
Thus, each actual sole floor reactive force moment is 
calculated in the moving target sole floor reactive force 
center point and, based on each, a sole is rotated around the 

sole floor reactive force center point, and a moment around the point is controlled to a desired 
value. Thus, control is facilitated without any interference between actual full-floor reactive force 
and each sole floor reactive force. 
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sij^woc**. cn#/mt©*s£K:mB-r-5>*- io 
$8ii:tt£fc9©>&#£l&£or*£&6tf. 

^(Ds^imU ZMP (Zero dtoment Point)iC»"5. @S 

Wfc^en^., JiiT©tftBj-cti. mML j &?<??>tc 

[0 062] £fi¥*R#©B«tt£Sfltefi¥flaE*j 

sestKti*. lORoniH? vtcftm? z±mmj*m± 20 

[0 063 ] C Ct, C©2PJ3©g^K-o^Tf?IB-rS 
t. c ©£&?§«. J^B>rifl&ffi£^S^tt*f uresis? 

tPa^*o/t 0 30 
[0064] ^©RSm-SSrSfc©^ 3 {C^-rttiR-ClfclE 

-rst. m ls^tt^iK^jwott^-sfcjjwcaiicS 

ap«. c©*-y> h^otci/i^imisir^ias 6 

[006 5 ] L.*>b£c#6. Slr©0^«:J:or. Sfli 
£¥©*>a>t&g#i*<&*©T\ ffn £¥J*577©§8 

1ZMP) £fc9©H^J^*-^>r*^{tr-&. 40 
[0 06 6] S£oT. J Sl"3>7'7^T>^$fl®«:J;^ 

t. e«^*g^c.\* (sizMP) $*do©^j* 

[0067] ■£ti%fjj±? or. M8P 50 



4#giW 1 1 -300 66 1 
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[0068] $/c 03 6(c^-rtfiR-e«. 

[0 06 9] JiLL©J:5K:. Slf3>^ A T>*MW 
[0 07 0] S£oT. filM©0SHt& fct->r 

«. @ffl^(5RJS7J*^**D«3©^)*S73*-^> h 

[0071] */c. -eniCcfcoTT^Kj^^tao^M^ 

[0 07 2]^. ±ieufcps*«9i-r^< . *a^A 
\mte.m33mu#*j h©*«®^§?rmssu-c*jo. c 
©^^©BWii-ewsie^^^ecc^L/. h&jst 

[ 0 0 7 3 ] 041*. c©^te©f^Cc^iWi^l!jn 

■» homumm (^<t i/tra 3 ©m 1 ©?a»^§8 0 

$>2>. «T. S4?:#MOrC©^g©^<*1tfi£ i &8liS 
[007 4] C©^g»*S^«S€:«S^, 

S«^ElcS*«t>** (iffiZMP) tdiifcJ: 
[007 5] c©S!ifc©ftJ.«tcfcl,»T^£^#Hi73 

'C^.«. i«zMP«c- grr -s. 



13 
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(8) ftfflW- 1 1 -300 66 1 
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^5> tfW3tJt«©m«:. B«iP2JETacS***^ 

[007 9] £ft6#fefr£«£-f *atII8 1 
WmS*!*©* -fA-?-i>-h£08tt:. 2 S¥ 

ft. C©S-C«£f (Ml 8, 2 0R(L))*>6J£ 

?22R (D ^©ffifi&SJ**ii££u miK-m-r 

<£5tca¥iit^£X«i©IE©ft#, S¥^f6l?rY«i 
©IE©fr 

[0 080] BW*jK*fl«8tt. ik. ttBSKra** 

. tf fcffiHt 3 2 % fcto*M«©fcftlc^ 
[0 08 1 ] &5£*ffll»TJJB©J:5«c|^3tifcB« 

tat. a«»s¥K5*©^*«gs±acs*«:-aLa 

[0082] 



20 



[007 6] h 1 rt^i&^ff-rSii*© 

BSJBtt-'ff-^©— Cft{c*flfrr4B«Z 

*. »lfif. t»5-**»2mi^Cii«. 
(89. ^£^©BWfflttfcfc**Lfc1SW¥8-2 I 4 

2 6 micmmtcm^hti-c^zov, cna±oaw 
[o o 7 7 ] 04©g&wcK-5.£. commmmmix. 

2tfM2S*flM.. Btt*K##I2Stt. S«£*E&4» 
<b& (SSZMP.) £B«a¥tta-sfil&*£ttA#& 

*ctt. ^g^JSRS*>e*8©^9y-* (0J*.«. WW 
^JH©lSlffl*»J»aWB*»J*ffiB&£> *£S 
©fSW • B$giJ («*.«. %^£l^jK$i$SB©8!)ti>*> 
6 0 .lsecTfe & tt £ ) ft £©»« fcsfcB-ttUS DtTBXO jA 
tf. 

[ 0 0 7 8 ] H 5 KS5T± 96*SK#OT. g*U$S 

aaiftfiJMRR^ip^^T©*^** 

*#1 > B«*STac5*tt»*M[*»l4*tt-C*S. 
^fr 2 ) PilKafJWrtt. S«fB 1 a¥J*JS#*>C\£« 
£ CC . S&SI 2 a¥J*J5* ■P'b&tto $ 3 * KfiFffi 
t4. * 

1 a¥fiaR# = B«£J*S#* <@«»2a¥fl5K#4'<C\££S«ZM 

p©ej»> / ( i jsE?&E&jifi'ta£& s*m 2 aspfiaK**^jS©si») 
swm 2 a^assa = a«±«cs* * ( sum 1 a¥fleEa«w>£& sszm 

• • -si 

[0083] C©J; 5 £*fe/c@#&a¥J*J5;>3««& 30 

WKSEftr sor. s»o^ ^mfzmm-r & tabic 

mun^i. ft. ±K©#tttt*IIMRA#SiBfett*0fc 

(#^¥-6 - 7 9 6 5 7^) tcsaifiSft-cc**. 
[0084H4 ©ta^tc^s <t . c ommmm&m 

^KJ^?r#ffi-rS. BP*3. MBKPiK? h*M&fT*S 
0 r <!: * & £-{C«^^r -5^{43 > h n - 

SC l/Cfc. h©(4B 40 

[0085]n# 9 Hl&m&gjmicftmtSitZIc 

4><&A (BiZMP) 4ffffl£iLTffli095«:|g43t 
[ 0 0 8 6 ] ft. jftsSBWasK? h©S8$8«sft5£ 

feWK©js**««*>6Sws«fc^{cfiiao. *tieff*. so 



«&*©«): 9KHj3Ror«>ac>. bp%. saw**- 
>«c j; o r «*-r stttt* im^j £ gs^^jJS*©^ 
^j*«i**wcc*ft. *n3W*ffi±©*s*«ci¥ffl^s 
*-y>h#. »ei»*to»j©ss»*»t>r«-c*aa 

[0087 ] 4>0. a^i-H^KmoT. ^ 
««3 2 43«fciy t aie!»tt«:3 4©fc*?*{cJ:oriD4 

a*-? h±(*©{aa • «»©«attnftm». «r©6 

[0088] -t— K 1 ) S*^flS6£A4M>j5 (StiZM 
P) *4>4>tl/A:Watt**>0@lK (BP*. 
*-F2) B«^flcS***ja (1SZMP) *4*ti 

*-F3) SS^J5RS^3t»4i\* (BtZMP) «r4>4>£ 

*-F4) m'&wmmsti 
*-F5> ttmmmsti 



15 



F 6 ) ±T¥tf#«lSn * 
[0 089 ] C©F*TC. K4 F5«, £¥© 

tffcgiflt 3 2 3 4 i>mm&iJifa(D1i:/Jfa 

^3 2 *i <fct>'£lg?*te<* 3 4 «I?K;fr|tn©ii14#S;i> 

[0090] ftuzumLtcim-eiz^t itt- f i t 

-enteijnitT. ojK» r£{*©PI6 (*- F 1^6 io 

6) CCitSW(C«iJ^Ofet-^^(D*l]^'ff^„ CCT 

Jg^<D^©iffl^t)-&^^»-r5= ft. aft?©{E&© 

fc*>. a«-r-5*s. 5fc©«*a«5*BMn-ra. 

[ 0 0 9 1 3 *- F 1 *IW»-r 
^JS^J©BUf*tt (X#) £ <) ^r- ^ > r ISS»-C* 

Mdrndx = - KthxSerrx - Kwx (d<9 errx 
Windy = - Kthy0 erry - Kwy (d0 erry 

CCt, Kthx. Kthy, KwxfciCfKwylJ. 

[0 094] «iW&«£3>:/'5-fT>;M&fRte£aJ 

[0 09 5]S4<DiiK^i, C©SSg«:SI&£¥ 

■fe>if 4 4 tc<fc or^*£¥«s* (-eo^ftnfe&ft 30 

UJU ^ft{c<fc^T6«rt-fe>-9-44©tfeHiffi*ffi«g 
[0096] camming v VStM^f^ (il** 

[0097] c<DmM(DBmx-i,zm**-?7~ ■< ?x<om 

tc. bp*>. ax? vmRfr^Mt. mm±Lfr&s-m 

w-&.m. • mm®.m £A2>u ^nhfrh i 2<i©nggp 
( i or (D ©nflsxtiUH* «a> *nmt so 



(9) ^fPi¥ 1 1 -300 66 1 
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^•<h&e$ii^ j e-^> h-js»/cw**«>n«a««>. fife 

©fiK^li . C ©HSS©ff5.®t?«ffl i>{tl,>©T0m>. 
[ 0 0 9 2 ] ft. «»»;*©?£»«:« 5. BP*. 
J5RS^)©*-y> hfiX^*ffl«^J*JS^-^> rMd 
md (l*t<tt@tl:£«5;ft#<l>.£ (1«ZMP) £fc 

^f*P<. W"J F©iW#|nl£X*t S^ft^Yl*. 
Jt# Z U(C <h 0 . mi £¥©£«rittT©J*cB±©.£ 

6fc©<b-r5o Mdmd©X^Mdmdx, 
YfiS^Mdmdy, Z(Sc#£Mdmd z <tiaj£-fS,, 
±&2 4©flS£4{IM (IP*. H-kfMI$4-aeLhl*flS 
14) 0 err ©X(&9-£0 errx, Yf&JHrG erry. C*l6 
<Dmr$$kftm$:(d9 errx / dt). (d© erry / dt)<hf2j$ 

[0 09 3] MdmdxfeiMdmdytt, 



/ dt) 
/ dt) 



312 



ft. -t^t'T^J^TfSiBft^i^trk&t.*. 
[0 09 8 ] C©^Bi^fi3>hD-7 (BMf3b/c^ 
2©iS»^8 2icp]D) ^(43>hn-7 

-c»ffi$nfcM«p^{iti^ (ffi) *B««£0-ca#» 
n © i 2<i©raffls©^ ; &iiee*fJP-rs„ 
[0099] MiBufcis-&=i>^ , 7-rT>^ibfP9aesiJ 

«. WT©2 0©S^ilS2-a-J: J 5 t. 
[0100] 1 ) a* v Y (Dim. • &$bMffl<Dtc#> 
JS^J (*-^>hMdmd) <t @S^JS^©^fCil 

^s-es. a^*^ h©^<s#fc'w^*ir<a)bfct»js^(c 

- ^ > h f&#/c W «:»fll^J6RS* * - ^>lMdmd(C 
[0101] S*2 ) SS^WSKfett^rfilS-r^/ci?) 

[ 0 1 0 2 ] ft. fflST-Si. ji^ti^)*^*** 
^JS^<t S«^S*©^CC-Sc3-B-%* 5 6gS§ 
S^J^g^tp^.Se^O©^^)*^*-^ > h Z 

T. 58*1) iS*2) «^K:MiE3-ti^Ci«-Ct 

[0103] ±12*BuSi Oria 107O--ft-h 
(fi|j§{fc-7D- • 3^-h) 5r#SBb-CC©^M©ii)f^ 

*isi?«-r^= ft. @©^KK^-rsj&a^tf ^@4ii 



(10) 
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[0104] 5trs i oic*s^xm&&nmtL. s i 

2%mxs 1 4&cjl<&. Wvld«3&<&£fmf S. * 
-fvf!l0j£#«5 0ms Ci&C&Sft. BP^. SWiBUgJW 
«5 0ms?*S 

[0105] m^XS 1 6{C^-C*^f©^JO#*>«3 

b. rot. ^mwowo^os^s^JKu. sss 

7 S8tr'^^-$'t*J§J'J<'' ; 7^--£ (ZM 

[0106] s 2 2 tea*. BSBfcg©^®* 

PS8. CCT r$»j «X. Y, Z£IH(CtoWS rftSj 
[0107] £H>r S 2 4 «CjlL<,TrB*&ja¥0cR&* 
fci^WT^. *f*W«ctt. 08*jJ:C>*09fc:SVr<fc5 
*»W Sfii£3fc# & C £ rff -5 . 

[0108] m*T S 2 6 CCjiA,-CBlll&JETOK*)* 

[0109] «fc>T S 2 8 «Cjt*. «rBBLfc«*Hs>:* 
6 0 tt£4>HttJ#>5±{*2 4©««ft£*ci#-y h 1 ©« 

[0 l l 0 ] ffi^xs 3 0fcii<&, OiKs'HOtfciC: 

(BffilZMP) **>«5©) li^At-^OhMd 
mdx. Mdmdy«:#»S 0 ft^Ktt, ±&<®£4# 

186-3 r»flt^6lcS**-y>hMd mdx. Mdmdy 

[0 11 1 ] U^-CS 3 2KfiA/?£&&¥Jft£A€tt 

[0112] tfcl,»-C S 3 4 (Cjt#. WWffl^ft 0 d b v 
fcWS£fiRftenx (y) Chtt, 

nrfab/cs^a >7-7 >x»fip«3eaj*stf 5 fare 

[0 113] ^©«^3>^-<T>Xttf13>t>ESi5©fP 
is\.^xm \ l«CSWJ:S«Cjmfi 3 l t 2 2R (L) £1112 

s^p2 2L (r> izn&s.w-mfctiwi'EmisX^zviu 

[0 1 14] CCT-^? hJUF n a c tttJ&n£¥J*S 
2>©;*Jfi£#£i|-r„ h;UMn a c tttfSnJS^JS 
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2j©*-jt> HfS^^S-To hJl/Mn a c t ©fat 
«. fa^«l>EtL''r8#lt|51i3© J 6-^> h*sj6}c*>6S¥{C 

[0115] CflM*|ffl©B«£*E#tt. 0 1 2 JCtR* 

"ftfrjft (SSZMP) «c*5»*a«^BSS^*-y> h 
^9fMsumrefttiIt?«5 (SiKiO. B 

[0 116] Cft*«lKf^TB«&S¥JEBR#K:fl- 

Ersi. 01 3«:nVf j^k&So raatctsti-c. ^ 

^UbFnre f ttBSOSnjaTflaR*©*^** 
■4". ^h«nre f BBtilff n JS^JK^©^-^ 
>H5R#*3tT. ^2 h*Mn r e f ©ft#©it5ltt> 
Mn act £IbHSt?&£o 

[0117] safSU©fctf\ ±<*^^M^6CC®n^ 5 

[0118] Hfr^©^^^t*UMnmsiJ-c«. 

h 1 ©±<*««4<lM&tMte e r r x. 0 e r r ytcg 
-3l,>rffi«£J*5#*-^>hMdmd*l§Emir£. C 

©5i«fe©jgsir«isaf4 (zw) st>o©xt->?rfi]iai 

l/&t->©T\ Jift^S^J^e-y > HMdmd©ISilf4 

^«o-c*^„ ±#&g©jgttk*raiG &<,>©-?. ffl 

Wf&-r-5ffl«^S^3*-^> hMdmd£01 4tC^ 

•r. 

[oi 19] ^i$*«5t;$-a-?./c*(c{*. mn±m^ti 

«Mn£ OSZMP) StofJWSS^S^^-^Oh© 
B^^JS^J*-^ > h M s u m r e f i 
> d m d ©*a©*¥l&frfc:iat£ 

[0120] Btf^JK^k* (I8ZMP) 

XltmU±l*J3.t>*:'-J > hMsumref ©*¥*fa 
j&frttO {Sot, Mg£:fc©i£f£«i*£m7ni* 
i±Sfc«?>k:». BSZMPSt?^©^)*^*-^^ 

h©*¥^?r. Mdmd©*¥fi£#&CiSfi£;*-g-*ltf& 

[0121] c©H*S©0^.«:*o-c»^3>-77 W 
T>X«)fp9iSgp«. «T©^* ; Sr'C^SPg , 3riS'rS 

<t^tcs^<D{4g • ^^<gjE-rs„ 1 ) h 

©^»MI4?rS^bSfl®-r'2)fc«)K;. Bffi^^S^Jtt 1 ^ 
i(BSZMP) ^t)*)©!!^^^-^^ h©*^ 

t^j (x, YiA^rfa) rm*.. m®.±ffi53]*-*yv 

M d m d ©TK^^fiJ^^OCiifie 3 i± S „ ^*2 ) SS^F 
©Sl&14?rSt»-r-5>/c«?)tC. B«SS¥* 

s*">w>Mi ^ ^ *) ©uss^js^* - ^ > h ©^ftfii 

[0 12 2] (SI/. Bflj£©jl9. S^l ) <tS^2) 



Cll) 
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[0123] £¥©ftg • s6»©*iEtt. C<DU 

i ) mmm i &¥-m&t)#&&Q i t mwmz&^ms. 

#4m:v5Q2£S«&. fr^Tk^FSiSit&^M©;/*^ 
^ hJUV*3)<J{)^, 0 V ©;*;#;*«: 1 i-f&o V£ai5 

[0124] 2 ) 1 fi¥*EfctW>j£Q 1 ©ffi« 

BW^flsR**^. (liZMP) ^BKtJiC'JCffi 

«rrs. »»i/fca©jS4Qr tr*. hwc, sir 10 

& (BIZMP) *@IE*'Ci*:ffiai'<*h;uv*to»)K: 
2' its. 

[0125] C®BKft0 db v*ffM1ffltft&l»9. 
*fc£**Q 1 . te&WQ I' <D^Z f-JUQ 1 Q 

1' <t-T^ 0 HflUc. ttiWQ2 v fe£#Q2' ©^ 
l-.M/^i' h;l>Q2Q2' il6(CQl' iQ 

2' 

[0 1 26] 3) g«UilJ£¥£. ^tt^x.TCC-^i' 20 

h^q i q r («a±T»tt) s-sa. 

Q2- /cww^f&s-es. sttftosffi^s^^ia i 

[0127] 4 ) 3tfC. @«I3S 1 S¥£Q 1 ' 
fC. flftft&ffltfc (X«|) St>«5(C|5I^6l 1 X. ££f7f 
im (Y«) £ft9(C[n]fgft0 1 yKttBRSti*. 15 
««C. a«!S2£¥£atISI2JE¥£Q2' **'WCB« 

'igfimm (x«i) sfo0Kigfte2x. £*r*7fa«i 

(Ytt) SftOCCHKAe 2y^W@K3-l**. SKA 30 
6>nx, 6 ny£-eft-eftf&n£¥Xffi«ft. 9nS¥ 
Y*MWil»5. lel$Kf£©StI&£¥£B 1 7fc**rc 

[0128] «±©»«tof»#it*t?ttwft«. 

EEWNSttSEfeoTfc. &*ftfttt (J£JSti©BK>#IE© 
KXfc&ttl*. c©J:5«c»^kb. ttfltlbfHK 
KJtWLT*JS¥K«»Sftfctffe«*3 2^JSJg?i14 

*-r-snj*J5*©^fta<t©pa©H^« > wt^-th 40 
[ 0 1 2 9 3 #ft 1 ) mmmmn odb vtctizmrtu 

*<»Ma£* *>9 ©USS^PJ^S**- ^ > K*. (S^ 
[0130] «ftt2 ) inSfX»||ftKW*«ftl/t 
■MN&CfEJBr £S!ifl n SmS^J©*- ^ > h ©X fi£ 50 



1 1 -3 00 66 1 
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«CC». ITOc. WnSTY^afcWftatflPL-CBftBff 
nS^^^rlHlg^-lfSi. H^nfi¥)5KJS^©*-^ 
> F©Y£0£tt*HK4l:U ^-©ffe©)*Jg^JS^«^0 

[0131] ) PfMfflMRft 0 d b v . &£¥X»i 

«ft*»J:O t *fi¥Ylillfllft*IBIl^tc»f¥rSi. HSJE. 
¥AcSAOKfUia. *ft*ft**^«c»flEOfci#© 

[0132]#I41 *jJ:0'#142 » v Cti6©fil^{c!4 
fitt#*5Ci*Sb. 4#tt3ttCft6©ifcfftC«Btt 

[0 1 33] HI 8tt«^=i>^-fr>^»f^Be» 

©fl^fctasB-rs. 

[o 1 3 4] ttswat. mm±m.%.t>*:-*i/\-5t& 

mzta^WSLGBtELto*:-* > h M d m d ©#62£tT 

- M > h ft P, . ifcSSBfc J: n X 

(Y) fi«ftfcS8BKfct>T1iW£©*(Rfte d bvfei 
Mnx (y) *8t3E-r*: 

[0135] ^k. fcssftfcswMtfctcs-^rii 

5 ft & «*a^« 3 2 -^JSSJMtf* 3 4 ©^15 

[0136] WTWK-r* 4. > h 

«flt£flcSyj*->>hMdmd*. MWffl 
Hvldmddb. SSfift-^y l-Md 
mdlx, y. Mdmd2x. ytc^ie-TS. 
t-^^FMdmddbB, MWfiftft (J£¥±Tfi) 
0 d b v*»fp-*-*C4«:«fco-ca«^CRR^*^ 
(IIZMP) £ftDK&£¥«^©;fr^##fEa* 

-y> h©a^ffl-r-s>-5« 

[0137] MWffi«*-^> hMdmd d b©V#|Sj 
SSfoOO^MMdmddbviiEltS. jSa. h 

^hJ^Uil-Si. SiffiR^e-^FMdmdd 
b©U^l6j^Mdmd d b u »0 (Cg^Sft-S. 
ffl«ft0 d b v*mft\sXi>. m%j3<DUlj\(il*:~S> 

[0138] C©HSS©^"C«1i«^KJS^*-^> 
hMdmd©ISii:^[S]^* 1 0 J^©-C. Mdmddb© 
ISiS^fiS^M dmddbzfeO ft -5. 

[0 13 9] JSnS^Mfa-t-^hMdrnd IB. JR 



(12) 



K'feSo IlS¥i®^>hMdmdl0X^ 
^Mdmdlx, Y^Mdmd 1 ytmi£-?Z>* ST 

2x, G2y*mittZ>C£lC£-oZ&mm2£¥'J*fc* 



ftfflW- 1 1 -3 00 66 1 
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fcW-ffiWL^-J > h M d m d 2 <DXf&ft*M d m d 2 
x, YfiE^Mdmd 2 y <tfearf& 0 
[0 140] #ffitt. 0t)x.U^OJ:^^f 



Mcknddbv = Wdbx * Mckndx + Wdby * Mdndy 



5£3 



Mdmdlx 
Mckndly 
MckncGx 
Mcknd2y 



Wlx * 
wiy * 
W2x * 
W2y * 



(Mdmdx - Wint * Vx * 
(Mdmdy - Wint * Vy * 
(Mdmdx - Wint * Vx * 
(Mdmdy - Wint * Vy * 



Mdmddbv) 
Mdmddbv) 
Mdmddbv) 
Mdmdcfov) 



5*4 



[0 14 1] CCX\ Wdbx, Wdby, Wlx, W 
1 y . W2 x, W2 yte£ZW i n t &#fc!ffiS^i& 
X*$>2>o Vxte^ bfrVOXtfLftCDm. Vyte-^hJU 
VCDYf&frOimX'&Z. C<D*pr\ WintB, MWffi 
«ft *mtt *> C t £ o L fc£fleJR#* - ^ > 

[0143] ^fm<Dftffimm&%mWd b x, Wdb 
y, Wlx, Wly, W2x, W2yfciOTint(D 
^^£0 2 OKiST. 02OCD^£->te, KTOtt 

u r mz-r * e ± i, i >. 
[oi44] i ) mmmmnt^&^mmm^ 

[0145] as* 2 ) mmffimms£&&&¥-m{Hft 

i>K ttS^<Wflt^J*S**--y>hMdmdCCi!it,»ffl 

[0146] CCDRg, BSLNF^f¥«Ftt<!r««CCCEDr 

ifCDJ^iC. Sii«^e-^ > h OV^^M d m d 
d b v, S£¥ffl« j e-^> hMdmd 1 , Mdmd2* 

Wint = 1 

Wlx + W2x =1 

Wly + W2y =1 

[0151] $lfB$t1JMdmdd b v^gatCUTM 
SPiSfledbvWl r £¥<Dft g£ <*IE Itfc, 

KDSSl^Mdmd d b 
r^S*r^^^^o «*.KH2 lcOcfc^CCMffiJ^ 

i^t>ttiar*« % a d b v(Cctor^is^(D(4g^T 

[0 1 52] [HjfiltC, Mdmd2£a«UtLTffl2J£¥ 



S5 
5£6 

^5«S 
(Mdmdx - 



[0147] c®yw-ct*Ba^jaas**** <s«z 

MP) **>0©j|^fR^*-y>h<D*¥^nSllEK^ 
ffl«^J*S^^- > h M d m d 0>*¥#fi«E4Mc 

20 iS6 (Dp^^r tt & ^ < jftfrT & J: 5 Cc*# *R5Tr ^ 
[0148] 

Mdmddbv*Vx + Mdmdlx + MdmcEx = Mdmdx • • 
Mdmddbv*Vy + Mdmdly + MdmcEy = Mckndy • • 
[0 149] C*ifC5£3, SPRATS 4, 

OVdbx * Mckndx + Wdby * Mdmdy) *Vx + Wlx * 
Wint * Vx * (Wcbx *Mdmdx + Wdby * Mdmdy)) + W2x * 
(Mdmdx - Wint * Vx * (Wdbx * Mckndx -Wdby * Mdmd 
30 y))= Mdmdx - • - Si7 

(Wdbx * Mdmdx + Wdby * Mdmdy) *Vy + Wly * (Mckndy - 
Wint * Vy * (Wdbx *Mdmdx + Wdby * Mckndy)) + W2y * 
(Mckndy - Wint * Vy * (Wcbx * Mckndx -M/Vdby * Mcknd 
y)) = Mckndy- * • Si8 

[0150] MdmdxiMdmdy^tttOBSKo 

St 10. fcctO'SCl 1 *HH*ccillS-rtitfAir». 

• • -SC9 

• • -Si 0 

• - -ail 

ttftA0 2£}^UTif!2JS¥Q#K£^IELrk v H 

Witt*. ■2 2®<fc9fcnma^iM>a' 

2S^**i*Tifrfc**S*«^tl/«cl^ 
[0153] fi£^>r, S;6?:?eSf ^J:^&cS* 
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[0154] mr&f<Dftmmnfr$m®MM-c*>zm2 

0-Ctt. Wi n t^OKiaS-r-SCitCfco-C, i2 1 
©ttfc© £ *) tt . MBUtf 0 dbv 4>H£t* 
h <fco-Cfc. &JE¥«i«ft 

[0 15 5] JfftteftCiK:. 02 

^KS**-^>F*«*S-tt*Ct«*-C*i«fc^«cS: 10 

[0 15 6] *fc. ««l/-Cl,»<cl.»4*«:tt||Wffl|ft 
0 d b v*»fFT4C&KJ:5*£«Efrfc-.X > h# 

[ 0 1 5 7 ] OS 0 . 0 d b v jW&»«C»< 

fl»(c»< £*K«ia,JWtg{Rfij 6 d b v3&s«S»«:»*»a: 

i>©r. mmmicMmimn*s£v&g.¥ffitsmzmft 20 

1*. > h Md md < & 

So 

[0158] ttSKioTB. P*MflW*J:Cf£fi¥ 

Mfltfl £&frr s c i k «fc o rjitt sn*^*- > 

»<4o'CI/J5J|#*!*4. 
[0159] C©«^Tfc v . Mdmd*sc©H 

ftS-C&S&P.tf. ft$0mHtcft5-Qcc». Hftfte. 30 
If. Mdmd©A#3*^^-7'rCi-C*>, — flSftCCiiaj 
flpmccm&Scfc-c&Srt*. Sfl®^co^--7*>;u-7'y 
>**£4>^{t-TS/<:W-e. fP-X K;U--/i|f14«« 

[0160] i£*£3 ) «-«3t«FJHrtt. M»fiB«ftffl 

>hs < f s. ^»3t»JWrttii«i»fllft%^t3-er 

[0161] ) ^©stfe&^stes-rs/ci* 40 

<-TS„ S¥#J^6ii< lift re 
-e©£¥©£¥?iffift W^Tt, -£©J£¥©SU£¥ 

flgg^w^bbtto©^ ^mtemzzz-eti^tcttxz 

ztmz'hz <t^x &s» 
[0162] ?£.m*5 ) ^wsmft^ai^-rsc <t(c«fc 

ffimmzmv?2>ctic<i:^-cm®'czzm£m&*)*: so 
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> h ©^ftliilSmtt So 

[0163] Mxti mmmmn e d b v £&fp-rs c 

[0164] PH^-tof. o$ S £©x ;> Vtctfttcltfrfr 

toys. v *jimimi&vxi,>?>m-&K.te> vi>mm$\ 

tt> C©1t14*^0-C. ttS^<Mfctt<M)Wfi«£> 

[0165] mi*. M»ffi<Rft£&ft-rSft:«>©#ie 
IWdhx, Wd b y«^©=fc-5«C^-TSo 
[0166] Xj£#rt*Wd b x, Yf&B^Wd b y . Z 

WdbiMdmd©rtS(C&oTI,i§. fi^T, Mdm 
d£~^ HUWd b#ftJ&9-<h^©ia^#&c#8?U 
«.2 hJl/Wd b^ffl^/cW^fl&ttibT, ^i?h;l-Wd 
b©*£;*£aiG/c&©7!>5, S3tcJ:orS<ii>6n?)M 
dmd d b vf&Sifxi. 
[0167] C©t§^©Mdmddb v?ri23KS 

-r. chit mmmmn^m^-r^ct^^-yxm^m 

JKfr^-^ > h©Wd b^|SjfiS^-=&WrS7 ^ - K/N- 
•^^$U®)*?r1tf!S;TSCi*SttTSo 4>L. Wdb* 

mt\sX i>m±mm.t>t-^ > h©wd b^[S]fs^«% 

[0168] se-^r. MScfttt^^^L/c^Kii. 
Wd b^loj^:^^ h;l/V^|Sj«:— Sc3tt&*\ */c«^c 

>FMdmd©Wdb^i^, SS^Ffflftft Kffl e. 

Wdb£V©rt«AM (CSC SJ: "5 tClS^So -fH5£& 
S¥ffl«ftJCffl6#/ct^ e ce,«. WdbiVOWl 

«fc o/j^s < ^s«t 5 Kfssrr So 
[0169] ics-c. &¥<Dmm*m^m-&iciz. # 

S¥l8ftWt S C t tci -^TltiLiSMSf 
tt. Wd b xSr^Ssbttg^TS. Wd b^r6)<h-cd' (- 

;i/v*(Sj«-S( l u < & 0 . Mi8il§«ft©^i&#iiJjn-r 
S*i. ^st4A^-r. 

[0170] MWffl«ft^sa5ccot>rM«:»iS-rs 

t . S 2 4 WfflSft ^gi5©?S»J5ffi© @ 

MfflUffiwe d b v«0^©jp<it©$ns. 

[0 1 7 1 ] @2 4£#MLT!fcBrrS£. @«!&1J£ 
^JK^if^Q 1 tcf'Pffl-rS Flacti B«^2S 
¥J*JS^#4>*Q 2 CCf^fflTS F2act*i. gm±l*. 
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+ PQ2*F2act 



2ac t£. ;&5£K: J: «5 *at>£ . 

Mflf2act = PQl*Flact 
CC"C, P Q 1 M*ftMi** P . & *#iQ 1 * h Jk 
Q 2 B&j£tfP . »j£#Q 2 ©^i> h JUT $> 



* [0 17 2] 

• • -5U 2 

* [0 17 3] gfc. 5U 2©ftto9tc. ifc5££flH>"Ct> 

*3g _hB » t ^ £pm«i& C ». 



Mflf2act = PQl*Flact + PQ2*F2act+ MLact+ M2act 



3U 2 a 



0m.t>t-^> hMact Znitif&RlCteiT^Z. 

Mflf2actv = Mflf2act • V 
[0 17 5] Mf 1 f 2ac t 

n-McilUTM flf2actvfi It 
[0176] ^(C. MWffl«-*-^> hV^faffr^Md 

mddb v^mmmv i^zicmo. *ti$:> Mf i f 

2 a c t v f i 1 tfrhffiC* <BM*-^> hV^TtSjRR 
»Md i f f v£f#£„ 

[0177]^, fflHRffi? -f^B. Mdmddbv* 

- * > h * -c©e»n^©aj!miE§«f 20 
tt£&#-rs*>©-c&£. 

[0178] ;XCC S¥tfto^tS^i'©^(CJ:^MWi 
«HR*-y > h V;frftj$#^©I^£fT^ir;fcs?>©MA 
0ffdbv = -a*Mdmddbv 

[oi8i] mmc-x^cji-oxmmmmn edbv^ 

0dbv = Kdb * Mdiffv+ 0 ffdbv 
[0 1 8 2 3 »nfiiMMWI»lSaiKC-3l,»t:«iWrS 

£ . h 2 5 1*-?-©*©^ i &¥-xffimnmm$mmmm 
mzTTs-r-fn? ^0-c*«3. sriJE¥x*i«ft0 ixw 30 

BRWDftKJSW-r*. BftW«*BST**s. Sl£?Yffi 

#0 2 y hmmtcx&z. ccmi is?xi«Ae 

[0183101 &W-mixt>^-^ > h Xl&frM 1 a c 
t xZu-'txy ■< ;i/£tcjlu-CM lactf i 1 tx 
01£¥ffl«*-^> hXf&frMdmd 1 x£ 
WfcMl -f ^^JCilL/. -£*V&. Ml a c t f i 1 t x 
*>6$0. <IM*-^>hMd i f f 1 xSrft-S., MM 

m&nik&tmm. mmmy -t frziz. Mdmd ix* 40 

0 fflx= - alx*Mdmddbv 
CCral xBflr5£©S&r&£„ 

[o i 8 7 ] sfitc;xSK ioti i Sfxilfte l x 

01x = Klx * Mdifflx+ 0 fflx 

[0188)81 8(CMr>r|ftW^W^£. «iEa« 
J£¥ftS • ^j$»Hi2P«, efgHflHtft 0 d b v. m 1 £ 
¥X figGUS 0 1 x. lfnjE¥Yfii®£l0 1 y. IS 2 50 



★ [0174] #C(C. M f 1 f 2 a c tO^f bfrVUfa 
^Mf 1 f 2 a c t vSrfflttrrS,, CtoB. 

©rtfSiSSt^^/c^Ki^o-cffenSo ra. ^i»h 

10 £ 0 



• • • SI 3 

*W«flMSi«a0 f f d b vzm&z. ctott. oto 
[0179] H&ffJKB. PSIWH**-^ > h V^fafiS 

»m d m d d b v tmtmtoiM&zm-ri&ffi? >7v 
jTisz^rfrzmi.K mmm 1 s¥j*js^*-c^q i 

£ S«B 2 M¥*S*+'C^.Q 2 ^^^^©^Jf^Jg 
^to©^*J^bfcfc©£[!Wmtff^?f« 
ftflf f dbvittii^. 

[0180] mmwrnmrnn effdbvit am 

• • -S14 

jE©«i(ca^-r-5.o 

• • -SI 5 

[0184] #(t, S¥Bto« 

mu£<imfci l c&z>& i s¥ii«^-^> hXRg^© 

[0185] AftroicK. f l£««^> VW^j 
«»Mdmd 1 xi^MiOM^a-rtilirJ^^' 

-en©@tt^sKufc4>©^m i S¥xts«^ffi«« 
0 f f i xitnisg^. 

[ 0 1 8 6 ] 0 1 S¥X«m^^*i«ft 0 f f 1 xB. 

• • • SI 6 

^x^fts. cc-ck i xB$oaiy-f>-c*«5. c 

tofciE©ffl«:g;^So 

• • -SI 7 

XIIW0 2X. *2S¥YlSft0 2yfeJ:^i 

^fit (c»-^#. Mai©a^3>^^-<T>^ 

So 
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[0189] mmmm&mmz* sm^sw-mfxtnc 

<fc -> -C^4*^i« $ ft & tffcHfit 3 2 ^S&Pttft 3 4 
©^»£#ai>S. 

[0190] 8l«^B»«{flA') «UEB*UB¥tig ■ §69» 

[0191] mz.it. 02 6«c^r«t5tt«flBEjg«*« 
s • 02 7 {c^-c^-rfeg • ft io 

■S. BP*i. H2 7Kn%-T«MlBBI51iflia©JS¥*>B*a 

w-WiWi *«w r se& L/ciir ©&g • 026 

[0192] MEXHMtl*. «fc<S8l 3 2 ^S^iitt 

#3 4©^tc«fc^r^o^ll^(4g • 5£i&©-rft£ 
Jl^t-rsc 20 

[0193] _hf2£iiu3B<fc Lti 1 07a- • ^ + - H 
©IsiB^cM^i. jw§a©£n<. s 3 4Ccfcc^r±iBb/c 

[0194] 02 8W^-©fP*^-r-9-^U-9 L > • 7 
[0 19 5] HH**J8LTBMirr*£. Jfe^S 100 

(cfct^rBuiaLifc^^ h;i-v*5jc*. s i o 2«cjiA/c 
tt®cne©i**»5 t &i,>rs 1 o 4t<cm&. s; 

Sfci^KA^tSfiMS^t-^hMclmd 30 
^|SS«lffl«*-^> HMdmd d b v iSS^Fffl^-t — 
y> HMdmdnx (y) it#EU S 1 0 6tCjiA,-C 
&$©&< 0 d b v *3Rft. S 1 0 8 tcj&A, 

6 n x ( y ) *#J?>.5>. 
[0 19 6] 01 0 7 a- • ^ + - KDt&lp!K:f?££. 

[0197] ^CH-CS 3 6 {C«*. B*§ga¥J*&7J«: 
I-3^Tl8»i(W4IHi 1/ . S 3 8 tcjfcl-ca* 
£7fika-j»»««fltA0dbv. 6>nx (y) . fcj: 40 

vwiWimmL mm) tc&crmEu. 'wtcMm 

[0198] *»tS 4 0 «Cit#, ±<*ftg • sgf§£II 

«a) zmaiL. S4 zKm^x-^B^^nm^u 

tcmB^m^ (fit) CC-9-->KfHf9L. S4 4(Cj^t 
mm*A tHfrU S 1 4tcKor±IE©^®*^')j5 
T. 

[0199]CCt. 1107O--?t-F©S35 50 
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[ 0 2 0 0 ] ±SEL/c S 3 5 ^ffirtrbft^fW 

©*-y > h *tfes«:*iiaii'r 

[020 1 ] *mMAftC<DtiiMtfflBm-f-cm$i? 

[0202] c®w»«. mmm\8.¥-tgmm2&¥- 

*n^n©s¥tcsc^jM(S]t?cc^3-tt5 0 c©«i^ 
[0203] c ©sospsrtf 5 t . m±mi3.t)tm&&¥- 

> h ictt LT S 3 5 ©JBHUfcHK MS-caS^/cP 
«KC : F»t4Cifit< l 3lilIlS¥©#fi!E#£3l*2J£ 

[0 204] -#©JS¥#ffc/j©£¥©2S:3rr £ 

it*? ^rs] tcfiji 3 a s 73©ft<5 i % -3 r u s tfc^^ t h 

[0205] -5-©^0*>e. d©H5S©^CCfc^r 
(i. ^tcSigLz/c^gfc^ 01 8©TSB«:^-rin<. 

[02061 029 &&<DwmzmM 

KStT'P ^0-C* 0.030 &*<DMmm'lT®W} 

&ft<Dm.wmv&z>. 02 9cc^-rin<. f^t>mm^iiL 

(DJlf&ftfrh. 03 0 {C^-T W9*ffi«^(4 D n 
(n=l. 2) Ztc. <giES«S¥{4§^ 

^©Uigi5«. -€-©SSW3^«^{4Dn?:#». ^ffl 

[0207] m3o zmmbrwaatzt. 

*5Q1' . ^.dSQ2' ©^i'hJUi. [SJ^^D-CA 

^?*«i ©^(S)'<i' c^ttnv tie 

[0 20 8] ^{C. S3 5©MS?rl^<MSr-ft6n?c 
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<gjEgt§S?UJE¥£. $»«£*.r(£. D1V tcVW- 

imtbs&z. s^©$p< , d i izmiEmmm i &¥© 

{iii,^. DIB. x*/7^grc*&.> 
[0209] RBftC. fKEB«*2fi5|t*. 5gf££^x 
TK. D 2 V «»3Rt»»S#*. D2BteIEB«fJ 

^©tfSSTB, DIB©. D2«jET*£. MS. Dl 
<bD2BMfe#jrc*Sfcs!>. HJS¥tt. iKffllltcft 10 

[0210] ±ia£03 17P- - H£#BgL,T 
3 6tCifclffltCS&lJB-r-5. 

[02 11] S 2 0 OKt$^t03 2©«aEWtt*^ 
■J 1 . ^»H3tStifc»lBfli«*SE»Wd 1 , Wd2©i 
&B$glj t CC*jW £fil£*tf> S. 

[0212] tllf>t S 2 0 2 «Cji*, m&&.^^3<0 

ftl&ftte £Z?Bm&&¥0lz%jl<D Jjtfift&ttl 9 k J: 
oTil^F d e r r £»tti^-& 0 BPfc. 12 9(C^t,t 
5«c. lOms^WRS^CD^jJdE^F 1 ac t. gggi2 JS 20 
¥flcR*WtfMS#F 2 a c t . @S» 1 £¥f*S2>©;>J 
BJE»F lref, *J«fcCfB*W2S¥flsRA©2HS#F 
2 r e f &©S (iU 9 ) K:J;-7-C{iSF d e r 

[0213] Fderr=F2act-Flact- 

(F2ref-Flref) • • -S19 
ft. eS^lS¥^Jg^©^R!c^F 1 r e f fciCXB* 
m2&¥-m%jJ<Dj]l&ftF 2 r e f B. HUf2Lfca«^ 

[0 2 1 4] ttCvCS 20 4K1*. JWHOfcflSF d 30 
e r r%S(IISP«<D^fi«:Ki±TSfc«t)©ta-A^7 ^ 
5r{c»U y-f >Kd{gbTMD i f f «r@i±J 

[0 2 1 5 ] 2 0 6(CjI#. (5£2 0. 2 

2>fi{^iD2£#ai-r-&. 

D 1 =-Wd 1 *Dd i f f ...5£20 
D2= Wd2*Dd iff ... ^2 1 
[0216] CC-C. Wd 1 fc«fcCXWd2B. #!ft©# 
Kfi*^»-C*4. Wd 1 iWd 2©ftlBl©££. D 40 

[0217] AEfflB»S9tWd n©gSE09BH3 2 4C 

■St. W®KjS*&hJl>*#5#&£TSC<b*>6. Wd n 

[02i8] tfc, s¥*ssia-rstitcwd n«t«r«c 

^3®l@l©3£Pli&S»^*-5. S£o-C. 50 
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Sttifi-CttWdnlMtCcr*. Sfc. M"S5:^fWB*I|® 
T>St*2.Ct*>e., Wd n£^Ccf MW^ 
f^Wfc.ttf&fiEFtcttWd 1 iWd2©ft* 1 K-TS,, 

[0219] *K»6ftfcP<afflffi«^<iD n 
010 70-- h©S3 8«c*a»TlifllSHBmflr 

A "9 flSIEgt?UE¥<i§g^#f?tH 3 ft*. 

[0 22 0] JMtftKtt. HMfflMKft 0 d b v. IIS 
¥Xfi«ft0 1 x, Sl£¥Yi«fl0 1 y. IS2JS¥ 
Xi«ft0 2x, I2S¥YiSft0 2y. 

t>mmt& di. *> <t t>*gi 2 d 2 teg 

[0 22 1] C©HiS©^S|-CB±ia©*P< . 4>&< £ 
(±(*2 4) <t. ButaSftKfg 1©H8®5 (10. 

12, 1 4R (L) ) ^Ita^SnSi^K. -e© 
%Mt,cm2<Dm& ( 1 8, 20R (L) ) £/M.-Cil*S 
SnSMSP (S¥2 2R (L) ) 4«*.fc*»# (2 
*) ©JUSIS (M9'J>»2) *»6»&SBP3£SWlciji<? h 

©suaissstcfc^-c . wtBcj^t v h <D^i»& < <b fefiiaa. 

&m • mm. etms^&g • mm) <fc. umbo** kc 
fFffl-rs^Js^j©e^^-> (ss^jk^j. mm 

£mm2)<Pfo&. ( = SSZMP) ) *'PU< theism 

g. S 1 0 #>6 S 2 2 ) . BflTiaSfiRS titc#®<D±mm 
^^Btfiasspc-e-n-entc^iB L/ci ^©friassp±© 

(BtWcS^^IBS. S2 4. S2 6) . MCeflHCflP 

ffl-r*sa*s* (*ss¥«s^) ?:^ai-rs^*s^ 

S3 2) . WEttas*ifcHBcR**»IWBl|taS*ifcB 

iaSgP?r@lES-li--5[nlgfi (PfWffl«fte d b v. z. 
6S3 4. M)WI««ft^§l5. *nfiWiflW8He». 

sioo^esio8). Huia^^n/csgciiiEStc 
mi asSP©(4g*J .i: S tc\mmi)m&? h 

a *> «:Boiaa«{4g*j &u/*idcmm*<&£.-$h% 1 
©jsspffig • mm^JE^m. (tii'£3>y7jT>z&}ft 
sfctgp. S3 8. S4 0. «iEB#js¥{4g ■ mmnm 
su) . Bffta^ai3ti/c**js^^6ii±j*s^(cs^b 

^ct^^J^ (Flact + F2act) 4#*-Cffirie 
4^?n/c^g©WM» (Flref + F2ref) 
i©HFd e r r. Dd i f f £®HJU Huf3f?m0 

fc<iMK:a-^t>-CBuiasa5©-g-n-en©««^{4D n * 
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5, S2 0 0^6S2 06) . ffiHSMM2tltcM®£& 

tBMNX£tt*HSi:. S 3 8 ) te«fcCKH«iB^ 1 fccfcOTKTfa 
mi fcJ:?>'IS2©£gi$(ig • «»*«ccJ:o TIKES ft 

t>*UI2©liBgp ( 1 0. 12, 14, 18, 2 OR 
(L) ) *S5ffi3-tt*H»Saa*S (a*-, h&H^* 

f^U * ^x?Hffg|5) . ^ia^r-n— 5. s 10 

40, S42) *flt*.*fci<l*(SOfc. 
[0 22 2] *fc. *!>&< <±f*2 4) £. ft 

tasmcm i omm ( i o . 12, hr (d ) ^ 

LX&RSti&t&iC* *©5te»K:*2©H» (18. 

2 or (D ) *^-uraassn*a» (js^-2 2r 

(L) ) *fS*fc«&# (2*) ©WSP (Wg|5'J>^ 

m a a # » i» «d4>& < i *> Miassp© m&sfc j; 

<&■•«»> i. HCatf? HcffifflTS^«gyj<oa 20 

1ZMP) ) £iJ>fc< tfcdtrtWBOjK'y Kt*St4 
titrs$8£lft?» S 1 0*5S 2 

2) . Hufai)iE3n/c^©^jg^*MiesspcD-?-n 

S24) , «nKS3KftfflTS*J*E*J (^Sfi^flcS 

Kfte^fRSAtttttS. s 3 2 ) . 3>a< 1 4>B?ta^m 30 

y. z) *»ae-i-sja«aiE«toe#a m^>y'^ 
Ay s 3 2 , s 3 4 . pfmtfltA&s 

flJ. JffnJE¥*§«ftifcE§B. S 1 00*6S 1 0 8) . 

«t of /* «sgf£# , Huiajfeg 3 n/c assgp^j^j * 

gmmiE^m (a^a^^r^xs&fmseas. s 3 40 
8 . s 4 0 , fgiEsas^ag • g&fftuas) . Baffin 
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